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PREFACE 


The Mars Mission Research Center is a cooperative program shared by 
North Carolina State University and North Carolina A8.T State University to 
broaden the nation’s engineering capability to meet the critical needs of 
the civilian space program. Its funding Is shared by the National 
Aeronautics and Space Administration and participating industries. The 
first workshop, held October 1990, was devoted to "Technology for Lunar/Mars 
Aerobrakes". The second workshop, held 13 January 1992 at Langley Research 
Center, focused on "Ongoing Progress in Spacecraft Controls". It was 
Jointly sponsored by the NASA Langley Research Center Guidance, Navigation 
and Control Technical Committee and the Mars Mission Research Center. This 

publication Is a compilation of the papers presented at that workshop. The 
technical program addressed additional Mars mission control problems that 
currently exist in robotic missions in addition to human missions. The 
topics included control system design in the presence of large time delays, 
fuel-optimal propulsive control, and adaptive control to handle a variety of 
unknown conditions. 


Dave Ghosh, Editor 
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Review of Mars Mission Scenarios 

Dr. Gerald Walberg 
North Carolina State University 
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MOW SHALL WK GO TO MARS? 


• Mission Scenarios 

- Far Term Missions 

- Initial Missions 

• Exposure to Reduced Gravity 

• Exposure to Space Radiation 

• Initial Mass in Low Earth Orbit 


Opposition-Class Missions 
2002-2015 



Mission Times (days) 
Outbound 172 - 334 

Stopover 60 

Inbound 250- 375 

Total 531-714 


AV’s (km/s) 

TMI 3.72 - 4.89 

M 1.78-3.93 

TIZI 1.24-3.30 

E 3.77 - 5.20 


Entry Velocities (kni/s) 

M 6.42-8.58 

E 11.39-12.80 
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Split Sprint Missions 
2002-2015 



Mission limes (days) 
Outbound 238 - 287 

Stopover 30 

Inbound 145 - 172 

Total 440 - 470 

AV’s (km/s) 

TMI 4.01 - 6.04 


Midcourse VSB - 3.47 
M 3.93 

TEI 1.99-4.21 

E 3.71-4.26 


Entry Velocities (km/s) 
M 8.57 

E 11.32-11.87 


Low Thrust Mission 


Mars 

Arrival 



Mission Times (days) 


Earth Spiral 

52 

Outbound 

510 

Mars Spiral 

39 

Stopover 

100 

Mars Spiral 

23 

Inbound 

229 

Earth Spiral 

16 

Total 

969 
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Staging From Earth-Moon Libration Point 



Mars Staging From Phobos 


Mars Approach 



5 












GROUND RULES 


• REDUCED GRAVITY EXPOSURE 
3 Criteria Considered: 

Cumulative Reduced g Exposure 
Cumulative Zero g Exposure 
Continuous Zero g Exposure 


• RADIATION DOSE 

Ignore Van Allen Belts and Nuclear Rocket 
Consider Galactic Cosmic Rays and Solar Flares 

- GCR's Vary with Solar Cycle 

Solar Flare Dose Varies Inversely with Distance from Sun 

One Giant Solar Flare each Year at Worst Time and Place 
Charged Particle Transport Analyses of Simonsen, Nealy, 
Townsend and Wilson 

- 25 cm H2O Storm Shelter 

Shielding by Martian Atmosphere and Terrain 


• IMLEO 

Rocket Equation Analysis 
(m s + m p )/m p = 1.1 

(m AB + nip/L) /m p/L = 115 

Isp = 4 80 sec and 960 sec 


7 


D, rem 


Crew Exposure to Reduced Gravity 


Flight I 

Experience i ^ AA_ Cumulative 

0 0 Wi Reduced g 





Cumulative 
Zero g 


Continuous 

Zerog 


t 


J 


0 12 3 


Symbol Missions Class 

• Opposition 

■ Conjunction 

♦ Fast-Trans. Con] 

A Sprint 


Exposure Time, Yr. 


Blood Forming Organ Radiation Doses 



Gonj. 
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IMLEO, kg N IMLEO, kg 


Earth Departure Masses 
Split Sprint Missions 



2017 19 2021 

Earth Departure Date for Manned Vehicle 


Earth Departure Masses 
Fast Transfer Conjunction Missions 



2002 * 04 * 06 * 08 * 10 * 12 14 2016 


2018 20 22 2024 

Earth Departure Date 
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SUMMARY 


• MANY VARIED SCENARIOS PROPOSED 

- Far Term Mission Candidates: 

• Extraterrestrial Resources 

• Complex Space Inf. astructures 

• Advanced Technologies 

- Initial Mission Candidates: 

• Simple Infrastructure i • Conjunction Class 

. Near Term Technology l • Opposition Class 

. Low Cost J • Split Sprint 

• Fast Trans. Conj. 

. SCENARIO CHOICE DEPENDS ON REDUCED 
GRAVITY EXPOSURE CRITERIA, IMLEO AND 
OTHER COST FACTORS 


Radiation Dose Important But Not a Mission Discriminator 


IMLEO is Useful (But Incomplete) Mission Cost Indicator 

_ Criterion = Cumulative Reduced g: 

— » Sprint — > Nuclear Thermal Propulsion 

Criterion = Cumulative Zero g: 

— > Sprint or Fast Trans. Conj. — > Nuclear Thermal or 
Chemical/AB 

When Cost Factors Other Than IMLEO are Considered, 
Chemical/AB and Nuclear Thermal Propulsion are 
Competitive 
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Element Mass (kg) 

MEV 

CRV 

MTV crew habitat system 

Truss strongback, struts & RCS 
Reactor/engine mass 
Radiation shadow shield mass 

EOC propellant 

TEI propellant 

TEI/EOC common tank (1) 

Aft tank total mass 

MOC propellant 

MQC tanks (21 

MOC tankset total mass 

TMI propellant 

JMLt an ks.12) 

TMI tankset total mass 

IMLEO 


81100 

5808 

58000 

5521 

3402 

9000 

0 

49067 

10307 

59374 

108930 

2om 

175620 

317220 

49375 

366595 

764420 
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STABILITY AND OPTIMAL CONTROL THEORY OF HEREDITARY 
SYSTEMS WITH APPLICATIONS FROM OSCILLATING FLYING 
VEHICLES, MECHANICAL SYSTEMS AND ROBOTICS 


Ethelbert Nwnkuche Chukwu 


Mathematics Department 
North Carolina State University 
Raleigh, NC 27695-8205 
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§0. Motivation. 


Consider an n-dimensional system 

*(0 = > 4 . r ( 0 , ( 0 . 1 ) 

where x(t) belongs to E u , the Euclidean n-spaee. The aim is to stabilize the rest position 
x = 0 by adding a damping term A|x(f). In practice the damping term which is added 
has a time delay because it does not react instantaneously but only after a time lag h > 0. 
Thus it is more accurately modelled by adding Aj.r(f - h ) instead of i4 1 x(<). The equation 
considered is 

x(t) = Ax(t) + A x x{t - h). (0.2) 

The problem then is to stabilize the rest position: find a necessary and sufficient condition 
for the damped system (2) to be asympototically stable. This problem is natural in systems 
where servomechanisms are used to improve performance and efficiency, in ship and aircraft 
stabilization and automatic steering. 

As reported by Minorsky in (7], [8], for ships exposed to turbulent waters the problem 
encountered is undesirable self-excited oscillations. Here the engineers aim to eliminate the 
oscillations. An automatic control servomechanism introduces the delayed damping term 
A\x(t — h ) to (0.1) to reduce the oscillations. In a similar situation the flap of an airplane 
wing is regulated by an automatic control. In such systems, controls u are introduced via 
a control matrix B to yield a system whose dynamics is governed by 

x(<) = Ax(t) + Aix(t -h) + Bu(i) (0.3) 

The aim of the control device is to ‘steer’ the system (0.3) to an equilibrium position as 
fast as possible. 

The system (0.3) is a special case of the dynamics of the deterministic model of a 
flying vehicle, which is derived in Kolmanovskii and Nosov (4, pp 120-123]. The equations 
have the form 

m - 

B 2 (s)q(i — s)ds -f D u(t). 

15 
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i: 


“ s)d$ + Boq(t ) -f- B\ q(t) 


This can be recast in the form 


*(<)- / A_j.t(< - s)ds = A Q x{t) 

Jo 

+ I /li(.s)x(< — s)(l$ + D «(<). 

Jo 


(0.4) 


The drives of control surfaces are described by Bn, where u is the control signal that drives 
the signals. In the above equation q is a vector of generalized coordinates. 


In the scalar case we have the one dimensional oscillation of the control surface, the so 
called control surface buzz [4]. If a rigid wing moves in a gas flow and turns with respect 
to an axis, the angular wing displacement are restricted by an elastic spring of rigidity k. 
The equation of motion is 


r°° 

9(0 + « 9(0 + *> 9(0 = *1 / J 0 (*)q(t - s)d* 

Jo 

+ *1 / J\ - s)ds + q u(t) 

Jo 

for some constrants a, b. In both cases u is a control signal that helps to stabilize the wing. 


The problem of interest which is proposed for investigation for (0.4) can be stated 
as follows: Find an optimal control subject to its constraints such that the solution of 
(0.4) with this control and with an initial state x (t) = <f>(t) t t 6 [-h,0] will hit the zero 
target in minimum time T and remain there for every after. Another problem we propose 
to solve is that of minimizing some effort or energy function E(u) = G(u(t)) when u 

is constrained, for the system (0.4) whose dynamics transfers an initial data <f> to a final 
point <I>. For physical applications particularly in aerospace where one is interested in the 
deployment in space of large assemblies of flexible structures, the performance E(u) may be 
fuel consumption, the maximum thrust available for the control system or the energy. We 
propose also to explore the problem of time optimality which minimizes fuel consumption. 


For the linear (0.3) or (0.4) the classical approach would be solve 
(i) the related initial problem of determining conditions for asymptotic stability of 


x(t) = Aox(t) + Aix(t — A), 
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or 

x(t) - Aix(t - h ) — A 0 x(t.) + A { x(t - h); 

(ii) the constrained controllability problem of (0.3) and (0.4), that is, the conditions 
needed to transfer any initial function to another using controls subject to its con- 
straints 

and finally to construct an optimal feedback control 

f:C-*U 

where U is the constraint set and C = ([-/*, 0), E n ) is the space of continuous functions 
into the n-dimensional Euclidean space E n . Instead of C we can use the space 
the Sobolev space of absolutely continuous functions x : [— h,0] — ♦ E n whose derivated 

i(<)<EL 2 ([-M],£ n ). 

Though a lot has now been achieved for (0.3) (sec the forth coming book, E. N. 
Chukwu [1], “Stability and Time Optimal Control of Hereditary Systems”), the time op- 
timal, minimum fuel problem of (0.4) has not yet been fully investigated. We propose to 
tackle the following problems: 

I: The stability problem for (0.4) and its generalization 
II: The controllability problem for nonlinear generalization of (0.4). 

which can form the base of technological knowledge necessary for the expected deployment, 
of large flexible structures in space. 

We now motivate the equations which we propose to study in problems I and II. 

§1. Mechanical Systems 

We now examine some simplified mechanical problems whose optimal feedback control 
strategy will be investigated. The linearized equation of motion of a single degree of 
freedom mechanical subject to a retarded follower force and control is given by 

+ (a - Fl)q(t) = -F( ? (( - h) + «(() (1.1) 
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The scalar q is the general coordinate, s is the torsional stiffness at the pin, m is the 
mass at the end of the light beam, l denotes the length of the beam, and F stands for 
the constant magnitude of the applied force. The measurable control u is introducted to 
restore the system to its equilibrium position in infinite time. The constant delay at the 
angle of the force is h. 

ed. 




Figure 1.2 
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If the model has two degrees of freedom the mechanical system has the following dynamics 


( 3m / 2 ml 2 \ ( < 7 , (i) \ / 2 s - FI - s\ ( q x (<) \ 

V ml 2 ml 2 ) \q 2 (t)) \ \ -s s - FI ) \g 2 (t ) ) 

/0 Fl\ ( qi (t - h)\ ( Ul (t)\ 

+ FI ) \*(t - h) ) ~ \u t (t) ) 

The two systems have nonlinear versions. 

§ 2 . Robotics 


Problems of the dynamics of Robotics must incorporate delays [ 9 , p. 30]. These can 
occur in the control system of the robot, in the transmission of information and in the 
mechanical part of the robot. Delays which occur in the information transmission are 
crucial in undersea and space teleoperations in ( 9 , p. 131]. 


Mechanical model of an elastic robot is described by the systems 


’9i(0" 


' 0 0 o' 


9i(0 

92(0 

= 

0 0 1 


92(0 

m J 


a 2 — a 2 —2kn 


v(0 



1 

o 

! 

o 


9i(f - h)' 

+ 

0 0 0 


92 (t - h ) 


1 

o 

e 

•4c 

CN 

1 

© 


v(t - h ) 


where « = 



is the natural frequency of the undamped, uncontrolled system and 


k - //( 2 m 2 ) 


the relative damping factor. One can of course introduce control variables on the right 
hand of the equation, and go beyond stability to study optimal control of the dynamics. 

§3. Controllability Theory 

Definition 3.1. The linear control process (4.1.1) is Euclidean controllable on the 
interval [<x, fj] if for each <f> G C and x x (E E n there is a square integrable controller u 
such that <f>, u) = <f> and x(fj,tr, <f>, u) — x x . It is Euclidean null-controllable if in 
the definition x\ — 0 . It is Euclidean controllable if it is Euclidean controllable on every 
interval [a, tj] t\ > a. 
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The conditions for Euclidean controllability have been well studied: See Kirillova and 
Churakova [5], [2], Weiss [11], Manitius and Olbrot [6]. They are all conditions on matrices 
representing the system. 

Characterization of Euclidean controllability in terms of the systems coefficients is 
available for the autonomous system, 

x(t) = + A { x(t - h ) + Bu(t ), (3.1) 

where Aq,A\,B are constant matrices. First introduce the so-called “determining equa- 
tions” , 


Q*( s ) = ^4 oQ*-j(-s) + A\Qk-i(!i - h), k= 1,2,3..., s e (— 00 , 00 ). 

= 0 


Q o(«) 


r D » 

\ 0 s 


*0 


(3.2) 


and define 


Qn(h) = igb(«),Qi 1 («) 5 e [o,*,]] 


We have: 

Theorem 3.1. The system (3.1) is Euclidean controllable on [0, tj] if and only if 

rank Q n (t . t ) = n. 


Remarks. Note that the non-zero elements of Qki*) form the sequence: 

5 = 0 h 2h 

Qo(*) = Bo 

Q\{s) = A 0 B A\Bq 

^(■s) = AqB (>4oA( + A\Ao)Bo A\Bq 

Note that if <1 < h, the only elements in the sequence are the terms [B,AoB , ... , A^~ l B\, 
so that JE n -controllability on an interval less than h implies the full rank of \B, . . . , Aq~ x B). 
If this has less than full rank and t\ > h, other terms can be added to Qn(ti) 


20 



§4 Constrained Controllability of Linear Delay Systems 

In the last section the controls are big. In this section we consider controllability of 

*(0 = W; *i) + #(0«(0> (4.1) 

when the controls are required to lie on a bounded convex set U with non-empty interior. 
For ease of treatment U will be assumed to be the unit cube 

C m = (u 6 E m : |itj| < l,j = 1, . . . ,m}. (4.2) 

Here uj denotes the ;th component of u £ E m . Consistent with our earlier treatment the 
class of admissible controls is defined by 

Uad = {» € Loo([(Mi] : «(<) € C m a.e. on[0,tj]} 

Definition 4.1. The system (4.1) is null controllable with constraints if for each 
<f> € C there is a t\ < oo and a control u € U a d that the solution z() of (4.1) satisfies 

x„(o-, <j>, u) = 4>, x h (<r, <j > , u) = 0. 

It is locally null controllable with constraints if there exists an open ball O of the origin in 
C with the following property: For each <f> € O there exists a fj < oo and a u £ U a d such 
that the solution i() of (4.1) satisfies 

x a {(T,<f>,u) = <f>, x u (o,<f>,u) = 0. 


Theorem 4.1. Assume that 

(i) the systems (4.1) is null controllable; 

(ii) the system 

x(t) = L(t,xt) (4.3) 

is uniformly asymptotically stable, so that there are constants k > 0, a > 0 such 
that for each a € E the solution x of (4.3) satisfies 
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Then (4.1) is null controllable with constraints. 

i 

§5* Optimal Feedback Control 

We now consider the problem of the construction of an optimal feedback control 
needed to reach the Euclidean space origin in minimum time for the linear systems, 

J v 

*(0 = A “ r i) + Du{t). (5.1) 

i= i 

Here 0 < r < 2r < . . , < r N = h\ A{ are n x n and D is an n x m constant matrices. The 
controls are Loo functions whose values on any compact interval he in the m-dimcnsional 
unit cube 

<7- = {« e B" : |«>| < 1/ J = 1 m j. 

We shall show that the time optimal feedback system 

N 

i(<) = Y. *A‘ - T}j + Bf(x( 0) (5.2) 

i = o 

executes the time-optimal regime for (5.1) in the spirit of Hajek (3) and Yeung[12]. The 
construction of / provides a basis for direct design, and it is done for strictly normal 
systems which we now define. 

Definition 5.1. Let 

Jo = {t = jr,j = 0,1,2,...}, 

and assume ,7 0 is finite. Suppose U(e,t) is the fundamental matrix solution of 

N 

i{t) = v4 0 i(t) -f Ajx(i - rj) (5.3) 

j = J 

on some interval [0,e], e > 0. Note that U(e,t) is piecewise analytic, and its analyticity 
may break down only at points of J 0 , (see Tadmor [10]). The system (5.1) is strictly 
normal on some interval [0,e) if for any integers 

hi 

rj > 0, satisfying ^ ry = n 
j=i 
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the vectors 


N 


Qkj( s ) = X^.Q/b-i j(* - rj) k = 1,2, s€ (-oo,oo), 


o 




j = !,•••, m; 


are linearly independent; 


and D = (fe| . . . />„,). 


It follows from Theorem 7.1.4 in [1] that a complete, strictly normal system is normal, and 
has rank B — min[m, n]. Indeed, choose any column b } of B and set r j = n, rj = 0 for 
i / j in the definition. 

Theorem 5.1. Consider the system 

N 

*(0 = Y A i x ( t ~ T i) + £«(<)> (5.1) 

o 

and assume 

(i) The system (5.1) is Euclidean controllable 

(ii) The system 

N 

*(o - Y ~ rj )> ( 5 - 3 ) 

j~ i 

is unifonnly asymptotically stable. 

(iii) The (5.1) is strictly normal. 

then there exists an e > 0 and a function / : Int R(e) — * E m which is an optimal feedback 
control of (5.1) in teh following sense: If 


N 


i(t) = A i*(‘ - T i) + B /W‘). Int R(e) 


(5.2) 


J=0 
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then the set of solutions of (5.3) coincides with the set of optimal solutions of (5.1) in I u t 
R(e). Also /( 0) = 0 for x ± 0, f(x) is among the vertices of the unit cube U . Furthermore 
f( x ) = /(*) = -f(-x) ■ If m < n f is uniquely determined by the condition that optimal 
solutions of (5.1) solve (5.3). 
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1. INTRODUCTION 

2. LOW-PASS FILTER DESIGNS 

3. CSI TEST ARTICLE 

A. CONTROL STRATEGY 

7. CLOSED-LOOP SIMULATION 

8. CLOSED-LOOP LABORATORY EXPERIMENTS 

9. CONCLUSION AND FUTURE WORK 


1. INTRODUCTION 


Problem 


Traditional control methods may excite flexible modes causing 
degraded performance or instability of large flexible space 
structures (LFSS). Control techniques developed for control of 
LFSS require a numerical model of the structure and some 
knowledge of model error. This will be increasingly difficult with 
the complex space structures planned for the future. If filters 
could be used to condition the sensor output, control 
design would be less demanding. 





Frequency response of filtered output 
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2. CONVENTIONAL LOW-PASS ANALOG FILTER DESIGNS 


Objective of low-pass filter design 

Preserve desired frequency components and attenuate undesired 
frequency components 


Conventional low-pass filter designs 

Filter approximations with frequency response characteristics 
which satisfy the following specifications: 

passband frequency, stopband frequency, 
passband attenuation, stopband attenuation. 


TERMINOLOGY 

Filter transfer function: T ( j <0 ) = — — — - = \T ( j CD )\Z 0 ( i CO ) 

U(ja> ) 1 1 J ' 


Attenuation: ® — — 20 log T ( jCD )| dB 


Filter Specifications 


Passband frequency 
Stopband frequency 

Maximum attenuation 
Minimum attenuation 


to = i rad / sec 

p 

(0=2 rad / sec 
s 

a = 3 dB 
max 

a = 20 dB 
min 


Filters satisfying specifications 


Butterworth: fourth-order 
Chebyshev: third-order 
Cauer: second-order 

Bessel: none (Bessel filter transition band too wide) 
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Figure 2.3 Low-pass filler specifications 
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Comparison of Filters 
Frequency Response Characteristics 


Butterworth: maximally flat magnitude response in passband 

Bessel: maximally flat delay characteristics in passband, 
largest transition band 

Chebyshev: ripple in passband, sharp rolloff, 
nonlinear phase response 

Cauer: ripple in stopband and passband, sharpest rolloff 
nonlinear phase response 
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3. Controls Structures Interaction (CSI) Test Article 


Some objectives of the NASA CSI Program is to develop and 
validate the technology needed to design, verify, and operate 
spacecraft in which the structure and control system interact 
beneficially to meet the requirements of future spacecraft. 


A CSI testbed has been developed to validate CSI design 
methodology, to implement practical sensors and actuators for 
LFSS control, and to evaluate controller designs. 


The Phase-0 CSI Evolutionary Model (CEM) was the test 
article used for this study 


CSI Evolutionary Model 
Phase-Zero 


Target Plane 
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Magnitude (dB) 




Figure 5.4 Frequency Response of CSI Evolutionary 
Model with Chebyshev filters 
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4. CONTROL STRATEGY 


Objectives for control of large flexible space structures (LFSS) 

Accurate line-of-sight (LOS) pointing 
Vibration suppression 


Challenges for control design 

Model parameter errors 
Incomplete model (unmodeled modes) 


Robust control methods 

Static dissipative control (local velocity control) 
Virtual passive control (2nd-order formulation) 


5. Closed-Loop Simulation 


Objective: Investigate the effect of sensor filtering on 
performance of feedback controllers 


A. Controllers developed without filter dynamics in the 
design model 

i. Static dissipative control fSD-0) 

ii. Virtual passive control (AvA) 


B. Controllers developed WITH filter dynamics in the 
design model (static dissipative control) 
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Tim* 



Figure 7.9 Acceleration reeponee 
controller AVA and Butterworth 


of closed-loop system with 
filters (sensor loestlon 1) 
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6. Closed-Loop Laboratory Experiments 


7 Hz mode unstable when sensor filters used in system 


Discrepancies between experiment and 
simulation due to 

MODELING ERRORS 
-inaccurate parameters 
-unmodeled modes 

DISCRETIZATION ERRORS 
closed-loop system is not a continuous-time 
system but a hybrid system 
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Amplrtud* (in/stc 2 ) 


(•) Aectltrom*t«r 1 


Figure 

system 



(b) AcctUrom*l«r 7 



8.7 Experimental acceleration response of a closed-loop 
with second-order Butterworth filters and controller AVA 
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Future Work 


Modify filter design: Add zeros to numerator to 

compensate for phase lag 

Formulate filter as a second-order 
system (corresponding to virtual 
passive control design) 

Stability conditions for hybrid systems 


Discretization issues: Method of implementing of 

digital filters 


7. Conclusions and Future Work 
Conclusions 


• Sensor filters used successfully in closed-loop 
simulations 

• Dynamics of higher-order filters must be considered 
in control law design 

• Instability occurred in closed-loop experiments due to 
design model inaccuracies and discretization errors 

• More accurate models of CSI test articles needed 

• Stability conditions for continuous-time systems not 
valid for hybrid systems 
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Motivation 


Unbounded Fuel Optimal Control Problems 

• Exact solutions are difficult to obtain 
for higher order systems. 

• Impulsive forces cannot be implemented 
directly. 

• Exact solutions provide basis for judging 
the optimality of approximate techniques. 

• Properties of the exact solution can be used 
to develop improved approximations. 

Floating Harmonic Oscillator 

• Model possesses both rigid and flexible 
body motion characteristic of proposed 
spacecraft. 



I. Fuel Optimal Propulsive Control 


II. Numerical Solution by Adaptive Grid Bisection 


III. The Floating Harmonic Oscillator 

a. System Definition 

b. Rigid Body Rcboost Class 

c. Vibration Suppression Class 

d. Cicncral Reboost Class 


IV. Concluding Remarks 
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Fuel Optimal Control 


in 

System Equation: x(t) = Ax(t) + £ b:ll(t) 

j=l H J 


Transfer the system from x 0 to x t 
Control Objective: in maneuver time T f while 

minimizing fuel consumption 


Fuel Function: 


in 

Fuel = Z 

j=i 



Fuel Optimal Control 


General Solution: 


Reachable State: 


m f* 

x(t) = eT 1 ( x 0+j I J () e bjUj(s)ds 


r T f 

ITI -Al .ATr 

y=Z J e bjUj(t)dt = e f x,-x () 




o 


Control Index: 


gj(T],t) = ri le ' A, bj j=i,2,...m 


Hyperplane Constraint: 


Index Extremum : 


H= <3 : 3 T 2 = 'I 

«*_ min max sup I p /« I 
a “ neH i<j<m 0<J<T f ' SjOU) I 




Fuel Optimal Control 


Optimal Control: 


ifj£j 


u j(0 = —r 1 - (j=l,2,...,m) 


a 


Impulse Vector: gj=[sgn j »8(t-T,j) -Sgn (g j (Tf,^ jJ ))5(t-T Nj j)] 


Impulse Coefficient Vector: 
Cocffu ient Constraint : 


£j“ t C lj C 2j — c NjjJ 


1 = lc 


i = r * i *.i] 


T 


r T T 

£ “ l £l £2 


T / 
■ ■ C m 1 


Optimum Fuel: 


* 1 

Fuel = — * 
a 


Adaptive Grid Bisection 

(1) Generate a square grid G of normal vectors 
"H 1 , ^ 2 » ••• J}p that form a subset of the 
liyperplane H. 



Figure I - Square Grid Generated in 
Step ( 1 ) in Which n=3 and L=2 
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Adaptive Grid Bisection 

(2) Determine 

0Cjj = o3Sr f lgj(ijid)l for each (i=l,2,...p) 

and for each (j=l,2,...m). The suprema ctjj are 

computed to within the error margin e , . 

gjOld) 


sup 

' XSV 'T^ // ^ i i 

' 

= n i 2 i, i 4 =r f 

Figure 2 - Sample Function lor Slcp (2) 
Suprcmuin Computation 


Adaptive Grid Bisection 


(3) Determine the grid-optimal normal vector r| 
for which ot = ,<i<p ,<j< m «jj - 

(4) Select an updated grid G of normal vectors r| 
v\2, ...Tip centered about the grid-optimal 
normal vector T|* based on the following: 

(a) If rf is an interior grid point, decrease 
the grid spacing by 50% (bisection). 

(b) If rf is a boundary grid point, increase 
the spacing by 50 %. 
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Adaptive Grid Bisection 



Figure 3 - 11* in the Interior Leads to Grid 
Spacing Decreased by 50% in Step (4) 



Figure 4 - r|* on the Boundary I. cads to Grid 
Spacing Increased by 50% in Step (4) 


Adaptive Grid Bisection 

(5) Repeat steps (2)-(4) until the grid spacing is 
within the error margin e 2 - • he converged 
grid-optimal normal vector represents the 
optimal normal vector if. 

(6) Determine the number of impulses Nj 
associated with u*(0 (j=l,2,...m), the 
corresponding impulse times Tjj (i=l,2,... Nj; 
j— 1 , 2 ,... m) and the sign functions sgn(gj(ifxy)). 


45 




Adaptive (irid Bisection 





r 

Floating Harmonic Oscillator 

- -i 

System Definition 


— y,(0 Uy2<0 


.. r>: '■ ; /„/•» -r- }- 

-■mm 

,> \ $t&3h'y?-j2'- ■■■■ 


u,(t) u^t) 

m iyi(0 + k(y|(t)-y 2 (0) = u,(i) 
m 2 y?.(t) + k(y 2 (t) - y,(t)) = u 2 (l) 

State Definition: X| (t) - + 11 x 2 (t) = y 2 (t) - y, (t) 

m 2 

x 3 (t) = *i(t) x 4 (t) = x 2 (t) 


Equations of Motion: 




Floating Harmonic Oscillator 


System Definition 


Slate Space Representation: 


x(t) = Ax(t)+£ b:Uj(t) 

j=l~ J J 


System Matrices: 


0 0 10 
0 0 0 1 
0 0 0 0 
0 o ?0 0 . 


" 0 ■ 
0 
1 

ni|+m 2 


b 2 = l 


m,+m 2 


Natural Frequency of Oscillation: 


kOriffn^) 

mjm 2 


Floating Harmonic Oscillator 


System Definition 


Matrix Exponential: 


n . n -sindl 

^At 0 COStOt O ^ 

0 0 I 0 

0 (osincot 0 coscol 


Control Index Functions: 


o = + smM n + __ 1 — coscol n 

W m | +m 2 T1 > 0)111 1 02 + in,+mV'3 m, '4 


■r m 2 


o _ ~ l - r> - sin^-n + —4 — -td+ 

82 - mj+m^i tom 2 T *2 + m i+ni 9 *3 


1 1,1 2 


US IU l T1 

m 2 ^4 


Reachable State: 


y = I-X10-X20 0 0 ] 


Hyperplane Constraint: 


r l| x 10 _r ^2 x 20 _ 
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Floating Harmonic Oscillator Rigid Body Reboost Class 

Initial Conditions: 

n 

(N 

II 


X l() ^ X 2()~^ 

Optimal Normal Vector: 

1 - =J * 
H 

1 

1 

s3 

o 

H 

Optima! Control: 

u*(l)= ^|-8(t)+5(l-T r )I, (J=l.2) 

^ 


Floating Harmonic Oscillator Rigid Body Reboost Class 



I 2 *45 6 7 8 

Tf (sees) 

Figure 5 - Rigid-Body Reboosl Class: 
Minimum Fuel versus Maneuver Time 
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Floating Harmonic Oscillator Vibration Suppression Class 


Initial Conditions: V 1 0 


mi+ni2 


x m — 0 


u nii+m2 

X 20=l 



m2 = s — 

m i: .. ■ ■ ■ 

05 I 

Tf/'lp 

Figure 6 - Vibration Suppression Class: 
Minimum Fuel versus Maneuver Time 


Floating Harmonic Oscillator Vibration Suppression Class 


Table I - Convergence Example: Vibration Suppression Class, 
m 2 =2m , Case, T f =2.0s 


1 OOtXXXXXKX) 

2 0 5<XXXXXXX) 

3 0 5(XXXXXXX) 

4 0 500000000 

5 0 51XXMXXXX) 

10 0.410156250 

20 0408424377 

35 0 408419866 

45 0.408419879 


O.OiXXXXXXX) 

0.500000000 

0.75CXXXXXX) 

0.750000000 

0.68750(XXX) 

0.656250000 

0655029297 

0.655029161 

.655029161 


0.000000000 
O.tXXXXXXXK) 
O.OOOOtXXXX) 
O.OCXXXXXXX) 
0.062500000 
-0.011671875 
-0.011526916 
0 011531452 
-0.01.1531410 


I .(XXXHXXXXX) 
0.50(XKXXXXX) 
0 25(XXXXXXX) 
0.I25(XXX)000 
0.0625(XXXXX) 
00019531250 
0 0000171661 
0 0000000141 
(KXXXXXXXX)! 


min max sup lgj(n,t)J 


] 4142115621731 
I 3041415111743 
1.1265267495443 
1.1265267495441 
1 1009325628441 
1.0811093227742 
1.0808406712402 
1.0808401197486 
1.0808401395811 
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Floating Harmonic Oscillator Vibration Suppression Class 


: y / 
0,5 “ / 

I- Lv2 


time (sees) 

Figure 8 - Vibration Suppression Class, 012=2111! Case, T f = 2 . 0 s; 
Displacement and Velocity of Each Mass versus l ime 


Floating Harmonic Oscillator Vibration Suppression Class 


si 
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Floating Harmonic Oscillator 


General Reboost Class 
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Floating Harmonic Oscillator General Reboost Class 



Jcncral Reboost Class, m 2 =2m, Case, T, =.s.; 
nent and Velocity of Each Mass versus Time 


Concluding Remarks 


• Adaptive Grid Bisection can be used to solve 
some fuel optima! propulsive control problems. 

' Fuel Optimal Propulsive Reboost of Flexible Spacecraft” 
"Fuel Optimal Propulsive Reorientation of Axisymmctric 
Spin-Stabilized Satellites" 

"An Hxact Solution to the Fuel Optimal Propulsive 
Control of a Tutorial Structure" 

• Exact fuel optimal solutions provide a basis for 
assessing the degree of optimality attained with 
approximate techniques. 

Linear Quadratic Regulator 
Independent Modal Space Control 
Impulse Damping Control 

• Knowledge of exact solutions can be used to 
improve the optimality of existing approximations. 
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Objective : 

To Conduct Experiments in Fuel Optimal 
Propulsive Maneuver of Flexible Spaceraft 
in order to Verify and Extend Recently Developed 
Theory and Apply to Various Classes of Spacecraft 

Ongoing Progress in Spacecraft Controls 
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I. Related Experimental Efforts 


II. Completed Experiments 

A. Experimental Verification of Impulse Damping 

Control 

B. Impulse Damping of the SCOLE Reflector and Mast 

C. Impulse Damping Control of an Experimental 

Structure 


III. Experiment Preparations 

A. Reaction Control System 

B. Rotating Flexible Beam 

D. IMAGE Testbed 

C. Aerobrake Configuration 


Ongoing Progress in Spacecraft Controls 
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IV. Current and Future Experiments 

A. Fuel Optimal Control of an Experimental 
Rotating Flexible Beam 

B. Fuel Optimal Aerobrake Maneuver 

of an Experimental Lunar Orbital Transfer Vehicle 

C. Fuel Optimal Propulsive Maneuvers of an 
Experimental Space Stucture Undergoing 
Translation, Rotation, and Flexible Body Motions 


V. Summary 


Ongoing Progress in Spacecraft Controls 
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NASA Langley Research Center CSI Program, i.e. 

Phase 0 


Ongoing Progress in Spacecraft Controls 


61 





Velocity at Actuator Location (in/seci 
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Load Cell Output (Ibf) 





Experiment Preparations 

Reaction Control System 


Supply Line Length Effects 

40 psi Supply Pressure / 12 ft. Supply Line 


Time (sec) 


40 psi Supply Pressure / 25 ft. Supply Line 


Time (sec) 

Ongoing Progress in Spacecraft Controls 
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r 0 






7 






Elastic Displacements at Actuator #2 (in) 



2 
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Experimental Verification of Impulse Damping 

Control 


Impulse Damping of the SCOLE Reflector and Mast 

Experiment Preparation for RCS, Rotating Flexible 
UlI Beam, IMAGE, and Aerobrake Configuration 


rY Impulse Damping 
KjLI Structure 


Control of an Experimental 


Fuel Optimal Control of an Experimental 
Rotating Flexible Beam 


Fuel Optimal Aerobrake Maneuver of an 
Experimental Lunar Orbital Transfer Vehicle 


Fuel Optimal Propulsive Maneuvers of an 
Experimental Space Stucture Undergoing 
Translation, Rotation, and Flexible Body Motions 


Ongoing Progress in Spacecraft Controls 
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Problem: 

Consider a non-linear, time-varying differential equation 
model of a multi-link rigid robot: 

D(q(t)) q(t) + C(q(t), q(t)) + G(q(t)) + H(q(t)) = u(t) 


D( ) : inertial matrix 

C( ) : centripetal and Coriolis forces 

G(), Il( ) : parasitic forces (gravity, friction) 

u(t) : applied torque 

q(t) : generalized coordinate vector 

Objective: 

Design a discrete-tiine controller which forces 

y(t) = f(q(D, q(0) 

to follow a desired trajectory, when non-linearities may be 
uncertain. 
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Note: 


S(q->) u(k) == T(q~i) y*(k + d) - R(ql) y(k) 
Let the desired closed-loop poles be 

P(q ')4 I + Pi q- 1 + ... + P/q* 


Then if the controller parameters S(q ■), R(q-*) satisfy: 


A(q ') S(q ] ) + q d B(q «) R(q <) = P(q l) , 
the tracking requirement will be satisfied with 


and 


T(q-') 


PliD 

B(l) 


m 


B(1) = X 

i=0 


bi 


Because A(q-*) and B(q-l) may be unknown, some 
identification method is employed. Here we use the recursive 
least-squares method, 


80 



Transforming the discrete-time model into parametric form: 

y(k) = $'(k- 1)0 

where$ T (k-l) = [- y(k-l y(k-n),u(k-l),...,u(k-l-m)] 
0 r = [a | ,...,a n ,bo,...,b m ] , 

A 

the recursive formula to update the estimate 0(k) is: 

0(k+ 1 ) = 6(k) + F(k+ 1 ) $(k) e°(k+ 1 ) 


F(k+I) = 


F(k) - 


F(k) 0>(k) $T(k) F(k) 
X,| + d>^(k) F(k) $(k) 


e«(k+ 1 ) = y(k+ 1 ) - $1 (k) 0 T (k) 

with forgetting factor 0 < < 1. 

'Hie closed-loop system is: 

[A(q ') S(q 1 ) + q (l B(q 1 ) R(q , )]y(k) = B(q ! ) T(q ') y*(k) 


y(k) = 


m ] i 

B(l) 


y*(k) 


where all parameters arc replaced by their estimates. 
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Issues: 


(1) Since the plant is really time-varying, we should construct a 
time-varying discrete-time model. 

(2) Since the plant is really nonlinear, we need to add a 
correction term in the control law for using a linear model. 

(3) Since the plant is really continuous-time, we want to add a 
correction term in the control law for using a discrete-time 
model. 
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I R(q-!) * 1 

Figure Is Mo del- Reference algorithm 
control structure 


8 :< 









Look at one link at a time: 


A(q ')y(k) = q d B(q ') u(k) 


where q _1 is the delay operator, y(k) is the discretized output 
(assuming a single output per link), d is the system delay and 

A(q- ! ) A a 1 + aj q _l + ... + q,, q~ n 

B(q-‘ ) A b 0 + b! q-' + ... + b m q~ m . 

It is desired to track a trajectory y*(t) which, when discretized, 
is denoted by y*(k + d). Further, any disturbance due to non- 
zero initial conditions should be eliminated. 
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Figure Is Model- Reference algorithm 
control structure 
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Note: 


S(q-!) u(k) = T(q-') y*(k + d) - R(qO y(k) 

Let the desired closed-loop poles be 

P(q-l) A 1 + p| q l + ... + p/ q - 1 

Then if the controller parameters S(q-!), Rfq 1 ) satisfy: 


A(q->) S(q _ 1 ) + q d B(q !) RCq 1 ) = Pfq 1 ) , 


the tracking requirement will be satisfied with 


and 


T(q-') 


_E£giLi 

” B(1) 


m 


B(1) = X 

i=0 


bj 


Because A(q ! ) and Btq* 1 ) may be unknown, some 
identification method is employed. Here we use the recursive 
least-squares method, 
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Transforming the discrete-time model into parametric form: 

y(k) = $ T (k- 1)0 

whereO T (k-l) = [- y(k-l y(k-n),u(k-l u(k-l-m)] 

0 T = [a | ,...,a n ,bo,...,b m ] , 

the recursive formula to update the estimate §(k) is: 

0(k+ 1 ) = 0(k) + F(k+ 1 ) $(k) e°(k+l) 

{ \ F(k) $(k) 0 T (k) F(k) 

F(k+I) = ^ F(k) "X, + OT(k) F(k) $(k) 

e°(k+l) = y(k+ 1 ) — $ T (k) 0T(k) 

with forgetting factor 0 < A,j < 1 . 

The closed-loop system is: 

[A(q-*) S(q'*) 4- q- d BCq- 1 ) R(q- ! )]y(k) = B(q-*) TCq* 1 ) y*(k) 

y(k) = y*(k) 

where all parameters are replaced by their estimates. 
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Issues: 

(1) Since the plant is really time- varying, we should construct a 
time- varying discrete-time model, 

(2) Since the plant is really nonlinear, we need to add a 
correction term in the control law for using a linear model. 

(3) Since the plant is really continuous-time, we want to add a 
correction term in the control law for using a discrete-time 
model. 
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Figure 2: Self-Tuning adaptive control 
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Adaptive Algorithm: 

Assume the continuous-time plant is described by: 

A(k, q- 1 ) y(k) = q d B(k, q* 1 ) u(k) 

Then the algorithm can still be used with the following steps: 

1 . Use the modified RLS to estimate the parameters of the 
discrete-time model: 

y(k) = $ T (k- 1 ) 0(k) 

where 

0 T (k-l) = [a t (k) a£k),b 0 (k),...,b m (k)] 

and <D T (k- 1 ) is as before. 

2. Calculate tCk.q 1 ). SCk.q* 1 ), ft(k,q _l ) based upon the 
estimates A(k,q 1 )» &(k,q**)- The ideal model is: 

A(k,q-1) S(k,q* 1 ) + q d B(k,q l) R(k,q-l) = P(q *) 

Tfk a*U - " ^ 

HM ) - B(k,l) 

m 

B(k,!) = ]T b'i(k) 
i=0 

Note here the closed-loop poles are still assumed to be selected 
as constants. 
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For a robotic manipulator, each link may follow the closed-loop 
pole 

P(q-l)= 1 + pj q- 1 +p 2 q' 2 
p, = - 2e' 5Wnh cos (V 1 - 5 2 w n h j 

p 2 = e ' 25w " h 

where h is the sampling period, 5 is the damping coefficient 
and w n is the natural frequency of oscillation, as selected by the 
designer. 

3. Calculate the control law: 

l 

S(k, q-') u(k) = t(k,q-') y*(k+l) - ft(k,q ') y(k) . 

4. Repeat step 1 until complete time duration. 
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Model 

Parameter 

Figure 4 

Figure 5 

Figure 6 

Figure 7 

n 

2 

2 

2 

2 

m 

1 

1 

2 

2 

A 

0.97 

0.97 

0.97 

0.97 

6 

0.9 

0.8 

0.9 

o 

vn 

60 

30 

60 

30 


Table 1: Simulation Parameters 


/ 

/ 

. / 



Figure 3: Two-link manipulator example 
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Robot parameters: 

• dji = 3j + &2 COS ®2 
d 1 2 ~ d22 = a 3 0.5 x 82 COS 02 
d 2 2 = a 3 

C j = — 3 2 (6i6 2 + 0.56j)sin 0 2 
2 

c 2 = 0.53 2 6 , sin 0 2 

g! = 3 4 cos 0 j + 3 5 cos ( 0 j + 0 2 ^hi = bj §1 + b 2 sgn (Gj) 

g 2 = 35 cos( 0 ! + 0 2 ) h 2 = b 3 6 2 + b 4 sgn ( 6 2 ) 

2 2 2 

where a t = mi /j + n^/j + n^ + b + I 2 " 4.93 

32 = 2m 2 /1 I 2 — 0.94 

33 = m 2 4 + I 2 = 0.90 

34 = (m t / 1 + m 2 /j)g = 68.65 

a 5 = m 2 / 2 g = 10.64 
b, = 6.82 
b 2 = 3.5 
b 3 = 3.91 
b 4 = 3.5 
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Figure 4a: Trajectory of the 1st link 



0.5 1 1.5 2 2.5 3 

Figure 4b: Trajectory of the 2nd link 
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0.5 I 1,5 2 2.5 3 


Fiugre 4c: Tracking error 
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0.5 1 15 2 2.5 3 



Figure 5b: Trajectory of 2nd link 
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0.5 I 1.5 2 2.5 3 

Figure 5c: Tracking error 
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0.5 t 1 5 2 2.5 3 



0.5 1 1.5 2 2.5 3 

Figure 6b: Trajectory of 2nd link 
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Figure 6c: Tracking error 
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03 I 1.5 2 23 3 


Figure 7»: Trajectory of 1st link 



03 1 13 2 23 3 


Figure 7b: Trajectory of 2nd link 
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Figure 7c: Tracking error 
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To include an error term to compensate for going from 
continuous-time to discrete-time, consider the model: 

A(k-l,q-«) y(k) = q d B(k-l,q») u(k) + E°(k) 
or 

A(k,q 1 ) y(k) = q d B(k,q- ! ) u(k) + e(k) 

where e°(k) and e(k) are the a priori prediction error and a 
posteriori prediction error, respectively. 

e°(k) = y(k) - $ T (k-l) 0(k-l) 

E(k) = y(k) - $ T (k-l) 0(k) 

These errors can be integrated into the closed-loop configura- 
tion and the control parameters may be selected to compensate 
for the errors. 

If the pole placement control law is used, the closed-loop 
system is: 

[A(k,q l) S(k-l,q-1) + q d B(k-l.q ') R(k-l,q ')]y(k) 


= B(k-l,q l ) Tfk-I.q 1 ) y*(k) + e(k) + £°(k) 



where e(k) is added to account for the time-varying discrete- 
time system. 

That is: 

n-i 

e(k) = ^ AA(k-i,q-!) S' +1 (k-l,q- 1 ) y(k-l-i) 
i=0 
n-1 

AB(k-i,q-i) si+l(k-l,q-0 u(k-2-i) 
i=0 
m 

+ ^ BKk.q 1 ) AR(k-i,q- 1 ) y(k-l-i) 
i=l 
m 

+ BKk.q- 1 ) ASKk-i.q* 1 ) u(k-2-i) 
i=l 

m n 

- V B‘(k,q- 1 ) AT(k-i,q* 1 ) y*(k-l) + Sj(k) e°(k-i) 
i=l i=l 

where 

S'(k,q-1) = q[S(k,q-l) - S 0 (k)] 

Si+'(k,q') = q[Si(k,q-')-Si(k)] 

Bi(k,q-') = q[Bi-'(k,q- 1 )-b i .|(k)] 

AA(k,q ') = ACk.q- 1 ) - Afk-Uq 1 )- 

Note e(k) can be calculated at time k-1. 


to:* 


We consider the control law as 

S(k-i;q-l) u(k-l) = T(k-I,q 1) y*(k) - R(k-l,q-i) y(k-l) + <j>(k-l) 
The closed-loop system is: 

P(q-l) y(k) = B(k-l,q-l) T(k-l,q-«) y*(k) + e(k) 

+ e^k) + B(k- 1 ,q- • ) <j)(k- 1 ) 

In the ideal case, B(k-l,q-i) is stable and e”(k) is given. We 
can calculate the correction input term <j>(k-l) as: 

w. n [P(q - 1 ) - B(k-l,q-l) T(k-l,q «)J y*(k) - e(k) - e'(k) 

^ )= B(k-l,ql) 


to cancel out e(k) and e B (k). But, in the actual situation, 
B(k- 1 ,q- * ) may be unstable and e*(k) is not given. We use 
e°(k- 1 ) instead of e*(k) to calculate <J>(k-l) as: 




Figure 8: Tracking error (including correction input) 



Conclusions: 


• Developed an adaptive control methodology which 
addresses three types of errors: 

• errors due to model linearization 

• errors due to controlling a time-varying plant 

• errors due to discretization 

• Further work is needed to 

• determine stability range of model parameters (5, co n ) 

• include prediction error term 

• determine efficient methods for tuning correction error 
term to improve transient characteristics 

• look at implementation on several robotic experimental 
testbeds 
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OUTLINE 
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and Unknown Noises 
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• Linear State Feedback Control System 


Process Noise Measurement 

Noise 



Reasons for state estimator 

(1) Number of sensors usually are less than number of states interested. 

(2) Intersted states are not always directly measurable. 

(3) System Is affected by process (input) noise. 

(4) Outputs are corrupted by measurement (output) noise. 


• Kalman Filter State Estimation 


process noise measurement noise 



Requirement: (1) A state space model of the system 
(2) The noise statistics (covariances) 
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• Some problems in control of flexible space structures 

(1) Obtaining a model by ground testing might not be possible 

(2) If an analytical model is used, modeling error could cause 
problem 

(3) Working environment is unknown 

(4) System characteristics might change (reorientation, structural 
damage, material deterioration, etc.) 

• Techniques In need 

(1) On-orbits system identification 

(2) Adaptive state estimation 

(3) Adaptive state-space system identification 


Problem statement 

Given the input/output data of a linear system, 

•suppose: 

(1) the system model is known but the noise statistics are 
unknown, 

(2) both the system model and noise statistics are unknown, 
how to conduct state estimation for control purposes? 


Ill 



• Stale Estimation under Unknown Noises 
(Adaptive Kalman Filtering) 

Three approaches: 

(1) Estimating noise covariances (Q & R) 

(2) Using weighting least squares method 
n (3) Estimating Kalman filter gain directly 


• Input-output Relationship of a System and of the Kalman Filter 

(1) State-space model of a system 



(2) State-space innovation model of the Kalman filter 


output 


i llt = /If, + flu, +AKe t 
)\ = C.f, + £, 


resfdual 


Inpul 


(\)y=\CUI-A) l n\u+\l+C(z!-A)'AK\E 
(2 )yr-{C(z!-A) % AK)yl\CUt -4) f /?|r/ 1 r 



output 


K : Kalman gain 
£ k : residual 





• Relation between Residual and Stochastic Part of Output 


s, = y, - ior'm/. , 
*■1 


= Eor‘*£, , + £,=£*».£,.. 


(MA model) 


residual 


residual 


e 

l+CUl-Ar'AK 

s 


MU ' ) 





e 

whitening filter 

s 



W’(z') 



stochastic part 
of output 


stochastic part 
of output 


£, = £n..v, (AR model) 
N(r')-M-'( z‘) or MU ')~N '{z ’) 


MU')=HCUI-A) 'AK 

= I+CAKz'+CA'Kz'+ iCA'Kz' 


• Obtaining Kalman Filter Gain 

(1) Invert the whitening filter 

N '(i ')~MU ')=/ + C/W* '+CVKz’i —iCA'Kz 1 

(2) Form two matrices 


G= 

C/1* 

//- 

C/\ 

r/i 7 




ov* 


(3) Find the least squares solution of K 

K = //<? where U'^UVliyW 

(4) Perform state estimation 

Jc; = At; , + Rii, , 
f; = f.- + ^(v.-Ci ( ) 





• Inverse Filter Method for Adaptive State Estimation 



State Estimation under Unknown System Model 
and Unknown Noises 

• system Identification 

• Kalman filter Identification 
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State Estimation under Unknown System 
Model and Unknown Noises 


Two approaches: 

(1) Identifying a system model first, then the filler gain. 

(2) Identifying a system model and the filter gain at the same time. 


System Identification: 

(1) Obtaining system mathematical models from input-output data. 

(2) Frequency-domain and time-domain 

(3) Model types: transfer function, difference equation, state space 
equation, impulse response, etc. 


For control purposes, time-domain state-space system Identification 
methods are preferred. 


• Input-output Relationship for a System and for the Kalman Filter 


process measurement 



system: y = \C(zl -/t)" 1 #1 m+| C(z/ -/l) |w+v 


• Markov Parameters and Elgensystem Realization Algorithm (ERA) 

(1) System Markov parameters (impulse response) 

y k = CBu k + CARu k 2 +- ■ • +CA H Bn k _ . + CAKe t _ t +CA 2 Ke k J +- ■ ■+CA i Ke k / + e k 

[cfl CAB ••• CA hl B\ 

[r/ttf CA 2 K ••• ca<k\ 

(2) Filter Markov parameters 

y k — CAKy ki +('AAKy k 2 + ,m, t-CA^ ^ AKy k _^-¥CBii k ^ + CABn k 2 t t -CA 11 ^Bu k ^ + F k 

\('AK ClAK ■■■ CA^'AK] A=A{1.-KC) 

[CB CAB ••• (VT '/i] 

(3) ERA (a system identification method) 

CB CAB ••• Ot y l fl] — — — ► [/V,B',C| 


• Relationship between Filter Markov Parameters 
and System Markov Parameters 

ARX model: y k = T OV + Y CA il Bu k ( i f, = V M,y t + Y /V,^. + f, 


(1) Markov parameters for stochastic input 
CAK -M { 



tlf> 






• Integrated Adaptive System Identification and State Estimation 


Process Noise 



Examples 


• Mini-Mast 

• Ten-bay structure 
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*»y 

Torque 

Wheels 



Top View of 
Tip Plate 


y Torque Wheel 



Location of Kaman 
Displacement Sensors 


B 



Fig. 6.4 Mini-Mast structure. 
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• The identified modal parameters of the Mini-Mast 


ii , cm 

Mod* 1 

Model 

Mt «fc 3 

Mode 4 

Mule 5 

tor 

fata 

ffoctltcd 

Fsvq. 

(nd/uc) 

Damp 

i%) 

Fuq. D*«p 
(nj/uc) <*> 

H*q. !>**»p 
(nd/ktc) (5) 

lm|. 

(ihJ/mx) 

Damp 

<M_ 

Fitq. 

(r**V*«) 

Damp 

CD 

IjOOO 

2J300 

IjOOO 

4jOOO 

s . ooo 

4.9463 

som 

30246 

3.0)66 

3.0261 

1.11 

191 

I.V7 

191 

1.9? 

3.0191 III 

3 0609 1 94 

3.0610 111 
50459 1.60 

3.040) 1.50 

1)0920 111 
37.4461 0.H 
27.4541 1 03 
27.3)49 093 
27.4746 I D 

315)4) 
311114 
34 29)3 
34.7625 
215041 

304 
1 4 5 
1 26 
m 
1.20 

34 6144 
3175)2 
34 7079 
317361 
31)314 

1 13 
1 22 
1.15 
1.13 

1.09 










• Identification of a ten-bay structure 


The Identified modal parameters 


Mode 

Frequency 

(Hz) 

Damping 

(%)_ 

1 

5.9 

0.27 

2 

7.3 

2.87 

3 

48.5 

0.40 


• Output and residual comparisons (3750 data) 




MB 

m 

1 







TUne(m) 



2 




Conclusions 


(1) Viewing the input-output relationship of a system through the Kalman 
filter provides helpful insights. 

(2) If the system state-space model is known, the Kalman filter gain can 
be obtained by whitening the stochastic part of the output. 

(3) A system state-space model and the corresponding Kalman filter can 
be identified at the same time from the parameters of an ARX (a 
difference equation) model. 

(4) For a stochastic system, a complete state-space realization is [A, B, 
C, K J, where the Kalman filter gain characterizes stochastic 
property of the system. 
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OI JTUNE: 


1) MOTIVATION 

2) FUZZY CONTROL 

3) RESULTS AND COMPARISONS 

4) FUTURE ACTIVITIES 



Figure l.l 


12*5 
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2m-I0 

10= -m- g-L- sin(0)+x 

T = Torque applied by motor 
I = Inertia = 111- L 2 


t = -Kp(e-e d ) -K d (e-e d ) -Ki I (e-e d )d< 


r 0 


0d = desired position 
0 d = desired velocity 

0 + co„ = -Kp- 0 -K d 0 -Kj [ 0- ds 


2 2 
w "'l 


y = 0 ds 


Mars Mission Research Center, N.C.S.U. 
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Philosophy: 


"The fuzzy algorithm is based on 
intuition and experience, and can be 
regarded as a set of heuristic decision rules 
or 'rules of tumb'." 


Mars Mission Research Center, N.C.S.U. 


Quantized Variables (Coarse Control) 


Quantized 

level 

y 

e 

& 

-5 

-90 

-100 

-1000 

-4 

-75 

-80 

-800 

-3 

-60 

-45 

-60 

-600 

-2 

-30 

-40 

-400 

-1 

-15 

-20 

-200 

0 

0 

0 

0 

I 

15 

20 

200 

2 

30 

45 

60 

40 

400 

3 

60 

600 

4 

75 

80 

800 

5 

90 

100 

1000 
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Graphical Representation of linguistic Rule 1 

Error (e) Error change (e) Control input (I) 



-4 -2 0 2 4 -4 -2 0 2 4 -4 -2 0 2 4 

Universe of discourse (U) 


(If error is ZE and error change is SP then control input is SN) 
Mars Mission Research Center, N.C.S.U. 
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Center of Gravity 



l 


u = The membership function 
U = The universe of discourse 
n = The number of contributions 


Mars Mission Research Center, N.C.S.U. 
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Three Joint Displacements With PID 
Alpha- 2303 For All Three Displacements 



■ Theata One 
— » — — Theata Two 
Theata Three 
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Displacement ( 


Three Joint Displacement With 
Tuny Ijopc Control 



— — Theta One 
~ — — Theta Two 
Theta Three 


Joint Displacement With PID 
Alpha- .2303 For Link One 
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0.3 


0.2 A 



-0.1 A 1 ! 1 1 I 

o 20 40 60 80 100 J 

Time ( seconds ) 


Position of Link Two vs. Time 
With Fuzzy Logic Control 



0 




Position of Link Three vs. Time 
With Fuzzy Istgic Control 



Joint Displacement With and Without 
Parameter Variation (PID) 



Mi to M2 

■ Ml Const. 
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Joint Displacement With and Without 
Parameter Variation (Fuzzy Controller) 



Joint Displacement With and Without 
Parameter Variation (Fuzzy Controller) 



- Ml to M2 
• Ml const. 


Ml to M2 

— Ml const. 


137 


Future Activities: 


• Coordinated Robotic Testbed 

- NASA missions for on orbit 
assembly. 

• Issues: 

- Flexibility in links/joints 

(R.M.S., .A.P.S.) 

- Adaptablity to varying inertia 

- Mobility of manipulator 

system 

- Master /Slave 

- Controller 

a) Tracking 

b) Vibration compensation 


Mars Mission Research Center, N.C.S.U. 
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F(t) := Y(l) - R(t) 

R(t) := Reformer Position 
l)(t) := Control Command 
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JUL 

AE(t)' 


Fuzzlfic 

aztlon | 

> 

i 

Control Rules 

> 

< 

Defuzzification 


A(l) 


The Universe Of Discourse Of The Functions 

The Error, E(t) , ranges from -1000 to 1000 
The Error change, AE(t) , ranges from -100 to 100 
The (Jain, A(t> , ranges from 0.2 to 0.707 


The following rules were Implemented. 

(1) If Efl) Is I.P and AF.(t) Is any, Ihcn Aft) Is I.P 

(2) If F.(t) Is MP and AF.(«) Is IT, Ihcn Aft) is I.P 

(3) If F.(t) Is SP and AF.(I) Is MP, Ihcn Aft) is MP 

(4) If Eft) Is 7.F. and AF.(t) Is any, Ihcn Aft) is SP 

(5) If Eft) Is SN and AE(I) Is MN, Ihcn Aft) Is MP 

(6) If Eft) Is MN and AF.(I) is LN, then Aft) is I.P 

(7) If Eft) Is I.N and AEft) Is any, then Aft) Is LP 
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COARSE LOOK-UP TABLE 


Error, E 

750 500 250 0 - 250 -500 -750 1000 


0.707 

0.707 

0.707 

0.625 

0.625 

0.625 

0.707 

0.707 


0.707 

0.707 

0.625 

0.625 

0.625 

0.625 

0.625 

0.707 


0.707 

0.707 

0.625 

0.625 

0.415 

0.625 

0.625 

0.707 

| 0.707 j 

0.707 

0.625 

0.625 

0.415 

0.415 

0.415 

0.625 

0.625 


0.625 

0.625 

0.415 


0.415 

0.415 

0.415 

0.625 

0.625 

0.707 

0.625 

0.625 

0.415 

0.415 

0.415 

0.625 


0.707 

0.707 


0.625 

0.625 

0.415 

0.625 

0.625 

0.707 

0.707 

0.707 

0.707 

0.625 

0.625 

0.625 

0.625 

0.625 

0.707 

0.707 

0.707 

0.707 

0.707 

0.625 

0.625 

0.625 

0.707 

0.707 

0.707 
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Three Joint Displacements With FID 
Alphas. 2303 For All Three Displacements 

0.4 -i 



Time (Seconds) 


■ ■ - Theata One 

— — — Theata Two 
Theata Three 
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Error Change, AE 












































































Joint Displacement With PID 
Alphas 2303 For Link One 



Theata One 


t hree Joint Displacement with 
Fuzzy Logic Control 



Theta One 
— — — Theta Two 


Theta Three 
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Joint Displacement With and Without 
Parameter Variation (PID) 



Ml to M2 

Ml Const. 


Joint Displacement With and Without 
Parameter Variation (Fuzzy Controller) 



Ml to M2 

— — — *M1 const . 


Time (Seconds) 



Displacement (Radians) 


Joint Displacement With and Without 
Parameter Variation (Fuzzy Controller) 



12 14 16 18 20 22 24 26 


Time (Seconds) 
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Future Activities: 
The number of rules 


• Overlapping of subsets 


• Matrix membership (shape) 


• Calibration Techniques 


• Predictor (time delays) 


Mars Mission Research Center, N.C.S.U. 
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Editor's Summary of the Panel Discussion 

The Panel was moderated by the Editor, Dr. Dave Ghosh, and 
consisted of six members, three from NASA Langley Research Center and 
three from the Mars Mission Research Center. The members from NASA 
Langley were: 

Dr. Raymond C. Montgomery 

Mr. Jerry R. Newsom 

Mr. Lawrence W. Taylor 

and the members from the Mars Mission Research Center were: 

Dr. Lawrence Silverberg 

Dr. Ethelbert Chukwu 

Dr. Gordon K. F. Lee 

Each panel member was given an opportunity to express his views 
concerning research needs and opportunities related to control systems 
technology for accomplishing a manned Mars mission. After this the floor 
was opened for discussion. This section of the proceedings is the editors 
independent interpretation of the comments made during the course of the 
panel discussions. 

It was felt that though theoretical development is essential, 
especially in the initial phases of a new control problem, experiments must 
be carried out in conjunction to establish a thorough understanding of 
problems and refinement of theories. In short, experimental activity is an 
essential element of research. In this regard Langley testbeds should be 
developed and made available to test new ideas emanating from the 
MMRC. It was recognized that in an university environment faculty tend 
to work independently and isolate themselves from practical problems. It 
was also recognized that 'design' is an important part of engineering 
curricula and there should be a balance between research and design. In 
view of this, MMRC is trying to integrate faculty from different areas to 
work in a design framework. It was also felt that research plans for Mars 
Mission should reflect its long term nature and should not pander to 
groups looking for quick results. 

Several suggestions were made for inclusion in the university 
research activity. Students should work on simple and fundamental 
problems. Computationally exact solutions, now available, should be used 
to revisit old problems and to throw light on new problems. On-orbit 
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assembly issues involving human and robots especially in the presence of 
time delay, should be explored. Also, human operator models should be 
developed and used in control system synthesis, analysis, and design. 
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